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NOMENCLATURE 


Diameter of the tunnel 

Cross sectional area of the tunnel and propeller 
Length of the tunnel 

Motor Polar Moment of Inertia 
Pinion Polar Moment of Inertia 
Propeller Polar Moment of Inertia 
Motor Shaft Friction 

Propeller Shaft Friction 

Motor Electrical Resistance 
Motor Back EMF Constant 
Motor Torque Constant 

Motor voltage 

Motor current 

Propeller linear velocity 

Water column linear velocity 
Total relative velocity 

Motor angular velocity 

Axial thrust 

Hydrodynamic torque 

Reduction Gear Ratio 


Water density 
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I. INFRODUCTION 


A. BACKGROUND 

Autonomous Underwater Vehicles (AUV) and Remotely Operated Vehicles (ROV) 
are performing increasingly complex tasks and missions, including search, survey, sensor 
placement, and sensory data gathering. The slow speed positioning and hovering of the 
vehicles during these tasks 1s accomplished by vertical and horizontal thrusters. Accurate 
positioning of the vehicles requires a thorough understanding of the thrusters, the forces 
they produce, and ultimately the effects on the vehicle. 

Researchers at Woods Hole Oceanographic Institute noted that closed loop control 
of shrouded thrusters commonly found on ROV’s may produce limit cycles and 
positioning hysteresis problems even if the system experienced no external disturbances 
[Ref. 3]. Naval Postgraduate School researchers modeled the tunneled thruster on the 
AUV HU pictured in Figure 1.1. By incorporating the acceleration of the tunnel’s added 
mass, the NPS model predicted that system stability may be enhanced by the influence 
of the tunnel [Ref. 1 and 2]. Evaluation of both models by Miles of the Monterey Bay 
Aquarium Research Institute [Ref. 4] indicated that neither model accurately described the 
rapid acceleration of small thruster propeller blades and the effects of fluid angle of attack 
on the blades. 

While there is a long history of work on propeller modeling, the usual focus is on 


propeller efficiency at constant forward speed for large ships and submarines. The much 





fer 


Figure 1.1 Naval Postgraduate School AUV H 
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smaller size of AUV’s and ROV’s, and the corresponding fast response of the vehicles 
and their thrusters during dynamic positioning requires an understanding of the full 
dynamic range of the thruster to insure motion stability. 

An improved thruster dynamic model must include a full four quadrant 
representation of propeller thrust and torque for both directions of propeller and fluid 
velocity to cover the full range of thruster operation. A similar approach was previously 
done at the Netherlands Ship Model Basin [Ref. 6] which used extensive experimental 
data to develop a four quadrant model of thrust and torque coefficients as a function of 
effective angle of attack for a series of B-screws. The coefficient curves where reduced 
to 10 or 20 term Fourier series expansions for use in models for propeller design and 
simulation of emergency backing bell maneuvers. It was found that the coefficient 
curves developed for these B-screws do not necessarily transfer for modeling of different 
propellers. 

In a study of cycloidal propellers [Ref. 7] lift/drag coefficient curves including 
blade stall as a function of effective angle of attack for cycloidal blades were proposed. 
Several unknown parameters had to be identified to match the curves to a particular 
propeller. This method was not directly applicable to thruster propellers but was adapted 


and used as the basis for the AUV II thruster model. 


B. SCOPE OF THESIS 
The scope of this thesis is to expand upon Miles’ analysis of dynamic first quadrant 


thruster operation, and to propose a simple lift/drag mapping over four quadrant 


operation while requiring only two disposable parameters to define the mapping, the 
maximum lift and drag coefficients. If the assumed functional form can be verified as 
appropriate, this improved model could be applicable to other thruster models where only 
a few parameters would need to be identified from simple experiments. 

Using the hypothesized lift/drag mapping, this work will compare the predicted 
results of the improved NPS model with experimental data recorded by Cody [Ref. 1], 
and derive a suitable control law for the AUV II thruster. Use of the control law in the 
vehicle during in water missions is the final result of this thesis. 

Chapter II will show the derivations of the two first order nonlinear coupled 
differential equations that model the thruster. Chapter III will validate the theoretical 
model with experimental data. Chapter IV will propose a control scheme and simulate 
thruster response. Chapter V will present the conclusions and recommendations of this 


thesis. 


Il. THEORETICAL THRUSTER MODEL 


A. THRUSTER DESCRIPTION 

The AUV II has two sets of thrusters forward and aft, mounted internal to the 
vehicle as shown in Figure 1.1. Each set has one vertical and one horizontal thruster 
assembly which allows for slow speed maneuvering, hovering, and station keeping. The 
internal mounting reduces drag on the vehicle during normal flight. Each of the four 
thrusters are a complete unit and tdentical except the horizontal tunnel 1s 16.5 inches long 
and the vertical tunnel is 10 inches. For the remainder of this thesis only the horizontal 
thruster will be considered. 

Figure 2.1] shows a cross section view of the thruster assembly. The four basic 
subassemblies are a DC servomotor, a set of reduction gears, a propeller, and the thruster 
tunnel. The small diameter of the tunnel requires the servomotor to drive the propeller 
with a gear train vice mounting the propeller on the motor shaft. This is the same 
configuration use for earlier experimental and theoretical work on the NPS AUV II 


thruster. 


1. Servomotor 
The following is a description of the DC — servomotor. 
¢ Type- Pittman PITMO DC MODEL 14202 
¢ Size- 2.125 in. diameter by 3.4 in. length 


¢ Speed- 3820 RPM (no load) 
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Figure 2.1 Cross Section View of Thruster Assembly 


¢ Torque- 106 ounce-inches (stall) 

¢ Volt- 24 volts 

¢ Current- 0.230 amps (no load) 

¢ Power- 333 watts (peak) 
Motor speed ts controlled by a PWM Servo Amplifier Model 30A8DD which uses a zero 
to ten volt control signal to modulate the pulse width of a load dependent 24 volt, 5 - 45 
KHz output signal to the motor. Motor direction is controlled by changing the polarity 


of the control signal. 


2. Reduction Gears 
The propeller is driven by the servomotor through a set of spur gears with a 
2:1 reduction ratio. The gear set has the following specifications. 
¢ Pinion- 45 teeth, 24 pitch, 1.875 in. pitch diameter 
¢ Gear- 90 teeth, 24 pitch, 3.75 in. pitch diameter 


The gear 1s a ring gear with the propeller rigidly affixed to the inside of the ring. 


3. Propeller 
The propeller was fabricated locally in the NPS machine shop. The 3.0 inch 
diameter matches the I.D. of the tunnel. The four blades are Kaplan type with 45 degree 
pitch and zero camber allowing for equally effective forward and reverse operation. 
Propeller thrust is transferred through two thrust/journal bearings and axially mounted 


Struts. 


4. Thruster Tunnel 
Each tunnel 1s constructed of 3.0 inch I.D., schedule 40 PVC pipe. The 16.5 
inch horizontal and 10.0 inch vertical tunnels match the inside dimensions of the AUV 
Il body. The servomotor, gear, propeller subassemblies are located at the midpoint of 


each tunnel. 


B. DYNAMIC MODELING 

The foundation for this development is based on two previously published dynamic 
thruster models. Cody [Ref. 1] and McLean [Ref. 2] developed the NPS model based on 
the NPS AUV II tunnel thruster. Yoerger, Cooke, and Slotine [Ref. 3] based their model 
on shrouded thrusters. Both used lumped mass, one dimensional techniques. The major 
difference between the models is that McLean/Cody included the acceleration of a 
cylinder of water through the thruster tunnel. The inclusion of the water column 
acceleration term causes the NPS model to predict a lead response to step inputs while 
the WHOI model predicts a lag response. 

Research by Miles [Ref. 4] and Adams [Ref. 5] suggested that better predicted 
response from the two models is possible if the changes in the effective angle of attack 
of the water column on the propeller during rapid propeller speed changes 1s considered. 
The velocity of the water column will lag the velocity of the propeller, causing the 
effective angle of attack on the blades to change, resulting in varying thrust output. The 
previous models related the volumetric flow rate of the water column and the thrust 


produced by the propeller only to the propeller velocity. 


This thesis will propose a simple four quadrant lift/drag model where propeller 
performance is variable throughout the entire range of propeller/water column velocities 
and changes as a function of the fluid effective angles of attack on the propeller blades. 
This is done while requiring only two uncertain parameters, the maximum lift and drag 
coefficients, to completely characterize the propeller performance. The overall thruster 
model is divided into three parts: electrical, mechanical, and hydrodynamic. The 
equations developed in these three areas will be combined into a set of two non-linear 
differential equations which are a function of two state variables, motor angular velocity 
@,, and water column linear velocity U,. The proposed four quadrant mapping provides 
the linkage between the state vanables, the thruster axial force, and the propeller’s 


hydrodynamic load torque. 


1. Electrical Model 
This 1s a standard dynamical model of a DC servomotor found in introductory 
controls textbooks. Figure 2.2 is a schematic of both the electric and mechanical systems. 
The motor law states that the torque produced by the motor is proportional 


to the armature current. 


The generator law states that back-EMF is proportional to the motor angular velocity. 


e=KyWy 


Th 





Figure 2.2 Electric/Mechanical Schematic 


Assuming winding inductance is negligible, solve Kirchoff’s voltage law for current. 





Substituting for current and back-EMF into the motor torque equation gives servomotor 
torque as a function of applied voltage and the motor angular velocity. 
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2. Mechanical Model 
The mechanical torque as seen by the servomotor is a sum of the inertial, 


frictional, and hydrodynamic loads on the motor shaft, drive gear, and propeller. 


+T nm prop ~ hydro 
N 


motor” !gear 
The motor shaft and drive gear torque is related to motor velocity and acceleration. 
eyed ee = Uva lira) Cepen: Cy Wy 
The propeller torque is related to the propeller velocity and acceleration. 
Tae, =) diy Ontee 
Noting that motor and propeller velocity are related by the reduction ratio, 


(oe = NO), 


the above equations can be combined in terms of motor velocity and acceleration. 


1] 


Equating the torque produced by the servomotor and the load torque of the mechanical 


system, 
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Simplify by letting, 
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Substitution results in the following first order differential equation: 


A 
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This is the first system dynamic equation where motor velocity 1s the state variable and 


motor voltage 1s the system input. 
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3. Hydrodynamic Model 
McLean [Ref. 2] derived a control volume, conservation of momentum 


equation for the thrust produced by a tunnel thruster which will be presented here without 








derivation. 
F, =(pALy)U, + (pAAB)U,|U, (2.5) 
met 
K,=(pALy) 
and 
K , =(pAAB) 


ie 


Substitute and solve for water column acceleration. 


go (FZ KU.) 
eT (2.6) 


Equation 2.6 is the second system dynamic equation where water column velocity is the 


state variable. In summary the two system differential equations are, 
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Figure 2.3 is the block diagram of the desired overall system model. The blocks for the 
tunnel and motor model have been derived in equations 2.7. The blocks that transform 


the state variables to axial force and hydrodynamic force will be derived next. 


4. Combined Four Quadrant Model 


Realizing that motor angular velocity is related to propeller linear wheel 


velocity U, by, 


Ol i. 0.72) 


U, and U, determine the magnitude of the total relative velocity of tluid over the blade: 
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Figure 2.3 System Block Diagram 
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Figure 2.4 shows the relationship of the magnitude and direction of total 
velocity as a function of the state variables as they change direction. Quadrants [ and II] 
are the steady state regions where U, and U, are both in the same direction. Quadrants 
I] and [V are transient conditions where the propeller has changed direction and water 
column velocity is lagging propeller velocity. 

Figure 2.5 shows the geometric relationship between the state variables. the 


relative flow angle, and the effective angle of attack. 
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Figure 2.4 Four Quadrant Relationship of State Vanables 
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Figure 2.6 is the proposed mapping of the lift and drag coefficients for the 
AUV II propeller as a function of effective angle of attack. This 1s an adaptation of the 
lift/drag coefficient model presented in reference 7 for cycloidal propellers. The curves 
in figure 2.6 assume no blade stall, which allows a continuous one term sinusoidal 
function to represent the mapping. This simple lift/drag model requires the identification 
of only one unknown parameter to characterize each coefficient curve, while retaining the 
physical amplitude and phase shift relationships for the lift and drag coefficients common 


to all airfoils. The equations for these curves are: 
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Figure 2.5 Simple Airfoul Theory Applied To A Propeller Blade 
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Even though the assumption of no blade stall and zero drag at zero effective angle of 
attack deviates from known airfoil theory, the simplicity these assumptions afford the 


model development outweighs the small inaccuracy introduced by the assumptions. 
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Figure 2.6 Lift and Drag Coefficients 
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Once known, the lift/drag coefficients and the total velocity vector can be translated 


into actual lift and drag forces by the following equations. 
Lift = ‘4 pv'A)C, 


2 


Drag =(5 pv?A}C, 


The lift and drag forces are resolved into axial thrust and transverse force. 


F, = Lift(cos(@)) - Drag‘ sin(8)) 


Ls 


F, = Lift(sin(6)) + Drag(cos‘8)) 


Finally, the transverse force is converted to hydrodynamic torque. 
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Using this approach, the axial force and hydrodynamic torque are functions of the 


system state variables, and the system dynamic equations 2.7 become; 


Wr eC een a) 


The system is modeled by two coupled nonlinear first order differential equations that are 
a function of the state vanables and the voltage input. Simulation of AUV II thruster 


performance can readily be performed with the system dynamic equations in this form. 


If, DYNAMIC MODEL VALIDATION 


A. THRUSTER TANK TESTS 

The experimental data used to validate the model derived in Chapter II was obtained 
by Cody [Ref. 1]. Figure 3.1 1s a diagram of the test setup use at the NPS test tank 
facility. An actual thruster assembly removed from the AUV II was used for the 
experiment with the exception that the servomotor was waterproofed so it could be 
immersed in the tank. Reference | describes the test equipment configuration and the 
calibration performed on the equipment. 

The test program consisted of operating the thruster servomotor through an 
extensive range of control voltage inputs for several tunnel configurations. Triangular and 
square shaped input voltages were used with periods of 0.5 to 50 seconds with amplitudes 
ranging from 9.0 to 20.4 volts. Propellers with 45 and 30 degree pitch, and tunnel 
lengths of 10 and 16.5 inches were tested. Measurements were obtained for thruster axial 
force, motor angular velocity, applied voltage, and motor current. From this entire 
experiment, three specific sets of data were chosen for model validation. A tunnel 
configuration 16.5 inches long with a 45 degree pitch propeller was subjected to 20.4 
maximum voltage inputs, with 2 second square wave, 2 and 50 second triangular wave 
signals. 

The velocity of the water column tn the tunnel was not measured. Therefore, the 


calculated values for the U, state were not compared to actual data, only predicted axial 
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Figure 3.1 Test Frame Assembly 





force and motor speed were compared to experimental data for validation. 


B. PARAMETER IDENTIFICATIONS 

The physical constants use to derive the thruster dynamic equations 2.7 that have 
known values determined by system and component design are listed in Appendix A. 
Four parameters associated with the specific design of this tunnel and the propeller blades 
were determined empincally by matching the model output with the experimental data. 
These parameters are the inertial factor y, and the momentum correlation factor AB in 


equation 2.5; the maximum lift and drag coefficients C, _,, and C,,,,, in equation 2.8. No 


attempt was made to derive the actual values for these parameters, even though a range 


for their expected values are known from experience with similar systems. 


C. VALIDATION 

The model was matched to one particular set of experimental data, then compared 
to two other sets of data for evaluation. The set of data used for determining the four 
parameter mentioned above was the 2 second period, square wave with maximum motor 
voltage 20.4 volts. The entire set of system differential equations are coupled so no one 


parameter determined a particular attribute, but in general changing y and C,,,,, matched 


Lmax 
the force transient peak, AB and C,,,,, fixed the steady state force output, and C,,,,, was 
varied to match calculated and actual motor velocity. The four parameters are restricted 
to a range of approximately 1.0 +/- 1.0, to maintain physical reality for the system's 
model. The model output and experimental data were qualitatively matched while keeping 
the parameters in a range that made physical sense. Figure 3.2 1s the model output 
compared to the experimental data with the following parameter selection: 


ee: ee: 


Lmax — 
© y=0.5 
> AD=02 

The values for these parameters are comparable to other airfoil or control volume system 


models. 
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Figure 3.2 Square Wave, 2 Sec Period, Motor Voltage +/- 20.4 v 
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Non-linear dynamic systems like this model can not be analyzed for frequency 
response and step response as 1s done for linear systems. The two second square wave 
input period was selected as the test case for tuning this model because it subjected the 
model to both transient and steady state conditions similar to a step input analysis of a 
linear system. The model was able to meet the criteria state above and matched the data 
closely. The model was then simulated with triangular voltage inputs of two and fifty 
second periods, 20.4 volts maximum motor voltage. The output was compared to the two 
corresponding sets of data. Figures 3.2 and 3.3 present the results of this simulation. 
Triangular wave voltage inputs are analogous to sine wave inputs use for frequency 
response testing of linear systems where high and low frequency response of the system’s 
model can be observed. The long fifty second period input can be considered essentially 


Steady state response. 


D. EVALUATION 

The propeller was designed to have symmetrical operating characteristics 1n both 
the forward and reverse directions. The experimental data indicates however, that the 
thrust produced by the propeller 1s slightly higher in the forward direction. The model 
output Is symimetric for positive and negative voltage input which presents a problem how 
to best identify the parameters and match the data. It was decided to match only the 
forward steady state thrust and not to incorporate this asymmetry into the model. Also 
the experimental data exhibits a slight overshoot for motor angular velocity. The model 


output has no motor speed overshoot. While the reasons for this are not totally defined, 
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Figure 3.3 Triangular Wave, 2 Sec Period, Motor Voltage +/- 20.4 v 
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Figure 3.4 Triangular Wave, 50 Sec Period, Motor Voltage +/- 20.4 v 
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it is possible that neglecting motor inductive effects could account for the over damping 
of the model. It follows that only steady state motor speed was possible to match. But 
for the these two exceptions, the model replicated the experimental data exactly using the 
values for the parameters identified above. The four parameters where held constant for 
the subsequent simulations of the other signal responses. 

Figure 3.3 shows the model’s dynamic response to a two second cyche input. 
While the motor speed predicted by the model matched the data closely, predicted thrust 
was high as the motor speed increased and slightly low during the down ramp. The 
acceleration of the water column will influence the thrust output throughout this entire 
cycle. Therefore the inertial term 1s distorting the model output. This could be attributed 
to the Y inertial factor, which is a function of the velocity profile of the water column, 
being slightly different during triangular voltage inputs. Additionally the lift and drag 
coefficients are not pure sine functions, and the errors introduced by this assumption are 
more significant during transient flows. The similarity of the wave shapes does indicate 
that during transient conditions, where changing angles of attack dominates the dynamic 
behavior of the system, the four quadrant concept replicates this phenomena closely. 

A significant feature of the dynamic response is that the peak thrust coincides 
exactly in time with that observed in the experimental data. The four quadrant model 
resolves the lead/lag dilemma between the NPS and WHOI models discussed in Chapter 
I]. 

Figure 3.4 demonstrates the static response to a long fifty second cyclic input. With 


the exception of the forward/reverse asymmetry for thrust, predicted output matched 


2] 


experimental data in both shape of the curves and magnitude. Since during this cycle 
when the momentum term dominates, the model’s steady state prediction 1s very accurate. 

The comparison between the simulation and experimental data was deemed 
successful and no modification was made to the model. The system differential equations 
2.9 together with the identified parameters were use for the development of the control 


scheme as explained in the next chapter. 


IV. AUV If THRUSTER CONTROL 


A. INVERSE STATIC MAP 
Hovering is accomplished by the AUV I] when the navigation force allocation 
subsystem commands the thrusters to produce a desired force to move the vehicle to a 
position required for the mission. Proper control of the thruster should produce an 
identical axial force output as the command force input over a desired frequency range. 
This chapter will describe a control scheme for the thruster that compensates for the 
nonlinear relationship between the thruster’s motor voltage input and axial force output 
to give the desire linear relationship. This will be for low frequency operations, when the 
system’s Static characteristics dominates the output behavior. The control law at the first 
level of precision will be an inverse static map as described by the block diagram in 
Figure 4.1. A force command input F, to the thruster will produce a linear force output 
i. 
Inspection of equations 2.4 and 2.5 reveals that in steady state conditions when the 
acceleration terms go to zero, a square law relationship exists between the thruster voltage 
input and force output. Figure 4.2 is a plot of the model’s predicted axial force output 
for a fifty second triangular wave voltage input. Except for some hysteresis at the origin, 
this is a square law relationship with sign preserved for forward and reverse directions. 
A least square fit between F, and v* calculates the linear slope for the plant’s square law 


Static map. 
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Figure 4.1 Open Loop Inverse Static Map Control 


F, =5(V VI) (4.1) 


The inverse of equation 4.1 is the control law interface between the force allocation logic 


and the thruster. 
V = Se hens 
yg Sen) (4.2) 


This open loop inverse static map control was simulated for high and low frequency 


command force tnputs to determine expected thruster force outputs. 
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Figure 4.2 Force/Voltage Static Map 


B. PERFORMANCE OF INVERSE STATIC MAP CONTROLLER 

The thruster output was simulated for two command force F, inputs using the 
control law developed above. The fifty second period triangular wave command force 
input demonstrates the system’s low frequency response while the five second period 
input reveals system dynamic response. Figure 4.3 only deviates from command briefly 
when the motor changes directions. Inspection of the state variables’ behavior during the 


simulation indicated that transient peaks in thrust during flow reversals is due to a step 


change in motor speed causing a spike tn the effective angle of attack. 


C. SYSTEM STATE VARIABLES 

Figure 4.4 is a plot of both system state variables U, and U, during the low 
frequency command input. Qualitatively this relationship makes physical sense with 
water column velocity lagging slightly behind propeller velocity while the propeller 1s 
changing speeds. As illustrated in Figure 2.4, the relationship between U, and U, 
determines the effective angle of attack of the water column on the blades, which in turn 
determines the propeller’s lift and drag coefficients. Figure 4.5 shows the effective angle 
of attack during the complete cycle. Except for when the propeller changes direction, 
effective angle of attack 1s approximately four degrees. The spike in effective angle of 
attack during flow reversals is probably an anomaly and is what causes the transients 
peaks in thrust output during simulation. Even though the propeller can change direction 
very rapidly, the actual change in the angle of attack of the water column on the blades 


is probably a smooth continuous transition. 
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Figure 4.3 Controller Simulation For Command Force Input 
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Further refinements to both the theoretical model! and the control law will occur 


after actual field testing of the control law in the AUV IL. 
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V. CONCLUSIONS 


A. CONCLUSIONS 

The rapid response of small tunnel thrusters necessitates an understanding of the full 
dynamic range of thruster operation. This is accomplished by incorporating a four 
quadrant map of the propeller’s force and torque characteristics into the system dynamic 
model while keeping the number of disposable parameters to a minimum. 

It was shown that the four quadrant mapping of propeller blade lift/drag coefficients 
as a function of effective angle of attack proposed in Chapter II predicted very accurate 
results for the AUV II thrusters force output when compared to actual experimental data, 
utilizing a srmplified but physically reasonable representations of the propeller’s lift and 
drag characteristics. The use of only four emptrical hydrodynamic parameters allowed 
two degrees of freedom to model propeller blade lift and drag performance, and two 
degrees of freedom to model the tunnel/water column mass and momentum 
characteristics. With the propellers thrust output as a function of angle of attack on the 
blades, the transrent peak of square wave response matched the experimental data very 
closely. 

The inverse static map control law produces good linear correlations between low 
frequency command force input signals and thruster output for the expected bandwidth 


of the AUV’s operations. If in water testing of the AUV II indicates dynamic 


compensation is necessary, this improved dynamic model will facilitate the development 


of full sliding mode control for vehicle thruster control. 
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APPENDIX A 


TABLE OF COEFFICIENTS 





Coefficients | Symbol Value 

































































Area | A | 0.00445 m* 
| Diameter | D 0.07627 
| Length | L | 0.4191 m 
Motor Polar Moment of ee | 1.63e-5 kg m? 
Inertia | | 
_ Pinion Polar Moment of Jie | 0.3186e-5 kg m* | 
Inertia 
iz ! | 7 7 | 
_ Propeller Polar Moment ip 3.448 le-5 kg m* 
of Inertia | | 
Sa a 
} Motor Shaft | Ca | 0.00022 | 
| Friction | 
ie 
Propeller Shaft Friction _ Cp 0.0 
Motor Electrical | R 1.73 ohms 
Resistance | | 
: | Mh - eee — 
Motor Back EMF | Ky | 0.055 volt/rad/sec | 
Constant 
‘a | ay 
Motor Torque Constant Ke | 0.0551 N m/amp 
Reduction Gear Ratio | N } 2 
Water Density | p 998.0 kg/m? 
i = ——— — | 














APPENDIX B 


%® FOUR QUADRANT DYNAMIC AUV II THRUSTER MODEL 

% This is the driver program for the system dynamic model 

% It defines system parameters and integrates the Differential Equations 
% 27 APRIL 1993 Dep JAMES PP. BROWN 


global T N A D Vmax KO K1 K2 K3 K& Rho pitch 
clear;cleg 


%® Known Parameters/Constants 


=a .0; % simulation duration 
Vs =83 % peak control voltage signal (v) 
Vmax = Vs*2.272; % peak voltage to motor 
ae) 0.0762; %® tube diameter (m) 
ee 4191; % tube length (m) 
A = 4.5604e-3; % cross sectional area (m 2) 
Sm = |.63e-5; % motor inertia (kg*m 2) 
wae = 0.3186e-5; % drive gear inertia (ke*m 2) 
tq = 3.448le-5; c propeller inertia (ke~m 2) 

om 00022; % motor viscous friction 
a = 0.0; % propeller shaft viscous friction 
R = i. 3; % motor resistance (ohms) 
— a5 5; % motor constant (volts/(rad/sec)) 
om.0551; % motor torque constant (N*m/A) 

ee % inertial factor 
Ne= 2.0; % reduction gear ratio 
pitch=pi/4: % prop 4&5 deg pitch 
delB = 0.2; % delta beta 
Rho = 998.0; % density H20 (kg/m 3) 


%® System Equation Coefficients 


oe—ecm + Cp/N 2 + Kt*Km/R; 
fape= Kt/R; 

fee im + Jdg + Jp/N 2 

K3 = Rho*A*L* gamma; 

K& = Rho*A*delB; 


tO=0.0; tf=T; x0=[0;0]; 

[t,x }=ode45('dynamics',t0,tf,x0,0.001 ); 

% Use the state variables to reconstitute system variables 
feetene th(t);temp=zeros(5,1); 

for i=1:1, [xdot,output]=dynamics(t(i),x(i,:));temp(:,i)=outputjend; 
alphae=temp(1,:);Ua=temp(2,:);Up=temp(3,:);F=temp(4,:);v=temp(5,:); 


fioiwmt,F),grid 


mie, 


APPENDIX C 


%® FOUR QUADRANT DYNAMIC PROPELLER MODEL 
%® This program formulates the nonlinear coupled 
% differential equations for thruster dynamics 

% 27 APRID #93 LCDR JAMES P. BROWN 


function [xdot,output] = dynamics(t,x) 


% Triangular Fourier Series 

Tp=5;Fmax=8; %cycle period and amplitude 

s3=[1 3579 11 13 15]'ss4=|1 -3 5 -7 9 -11 1315]; 
s2=sin(s3*(2*pi/Tp)*t)./s3 ./s& 3sl=(8/pi 2)*sum(s2); 
Fo= Emax “=st, 


% Inverse Static Map Control Law 
v=sqrt(41]1.018*abs(Fc))*sign(Fin); %S%motor voltage input 


Ua=x(1); wm=x(2); wp=x(2)/N; 
Up=0.7*Woa by 2 

W7=(Ua 27 Upe2), 

theta=atan2(Ua,Up); relative flow angle 
alphae=(pi/2-pitch)-theta;tangle of attack 


CL=1.75*sin(2*alphae); %lift coef 
CD=1.2*(1l-cos(2*alphae));%drag coef 


Lift=(0-5"RNhO V2)" AS GL; 
Drae=(OS4RhotV2) =22ac CD; 


"asLift*cos(theta) - Drag*sin(theta);%axial force 
Ft=Lift*sin(theta) + Drag*cos(theta);%trans force 
tane0L7? ~ D2 tart. hydraulic torque 


% System Differential Equations 
Uadot=(Fa - K&* Ua*abs(Ua))/K3; 
wmdot=-(KO/K2)*wm + (KI/K2)*v - tau/(N*K2); 


xdot=[ Uadot;wmdot]; 
output=[alphae;Ua;Up;Fa;v J; 
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